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ABSTRACT 


An autonomous roving vehicle capable of exploring 
the surface of the planet Mars has been under construction 
and continual development at Rensselaer Polytechnic Institute. 
An improved multi-laser/multi-detector triangulation scheme 
has been proposed to collect data on the terrain in the im- 
mediate foreground of the planetary rover. The purpose of 
this rep ord is to present a terrain modeling algorithm that 
would reconstruct the sensed ground images formed by the tri- 
angulation scheme, and classify as unsafe any terrain feature 
that would pose a hazard to the vehicle. This modeler greatly 
reduces quantization errors inherent in a laser/sensing system 
through the use of a thinning algorithm. Dual filters are em- 
ployed to separate terrain steps from the general landscape, 
simplifying the analysis of terrain features. Finally, a 
crosspath analysis is utilized to detect and avoid obstacles 
that would adversely affect the roll of the vehicle. Comp- 
uter simulations of the rover on various terrains examine the 
performance of the modeler. 
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PART 1 


INTRODUCTION 

Mechanical probes and remote sensing devices have 
long been used to explore regions that are beyond the immedi- 
ate reach of man. This is true not only on the Earth's sur- 
face, but also in deep space research. The first lunar probes 
were unmanned and were mainly used to gather the initial data 
on the moons's surface. High powered Earth based telescopes 
and "fly-bys" were able to pick out major points of interest 
that a probe could explore. These early probes were station- 
ary; once landed, they could not move. 

Considerable effort has also been focused on the ex- 
ploration of the planet Mars. Unfortunately, Mars is much 
further away from the Earth than the moon. This of course 
limits the resolution that may be obtained through telescopes 
for the purpose of positioning a martian probe. This would 
not be a problem if many probes were to be placed on the plan- 
et, however this would require a great deal of duplicity in 
the mission. Another alternative would be to have a few mob- 
ile vehicles that would roam the surface. Such a vehicle 
would not be limited to a single location; this eli mina tes one 
problem, but creates others. 

There is a very large communication delay time (from 
nine to twenty-five minutes) between Mars and any Earth based 
control station. If the roving vehicle were dependent upon 
messages from the Earth, it might take days to move several 
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meters, or more likely, the vehicle -would fall into a crater 
before the command center could prevent such a disaster. 

The vehicle then needs to be somewhat autonomous. 
While the extreme long range hazards could be avoided via the 
communications link, a short range detection system would also 
be a necessity. Such a short range detection system would 
make use of computing facilities on-board the rover itself, 
eliminating the dangerous time delay of the communications 
link. 

The autonomous rover being developed at Rensselaer 
Polytechnic Institute uses a laser/photodetector triangulation 
system as the short range sensor. A great deal of work has 
gone into the development of terrain modelers - algorithms 
that detect and categorize possible hazards. All previous 
work in this field has concentrated on slope calculations us- 
ing area analysis to detect hazards. While these methods do 
a fairly good job at detecting boulders, negative obstacles 
such a craters frequently go undetected unless they are very 
large. Sloping terrain across the path of the vehicle also 
presented problems to these modelers. 

The subject of this report is the development of a 
new modeler using completely different techniques, breaking 
away from all earlier modelers. The current version of the 
modeler using these new concepts draws slightly from pattern 
recognition ideas, processing data from the sensors before any 
analysis is performed. Results of tests show vastly improved 
recognition of both positive and negative hazards; and 


the problem of crosspath slopes o« slfsp^s In any direction 
has been virtually eliminated. 


PART 2 


SYSTEM CONFIGURATION 

The Mars Rover project has two major divisions, the 
hardware and software groups. The hardware group is divided 
into two smaller teams: one is responsible for all of the mech- 
anical aspects of the rover, the other must develop and main- 
tain the electrical components and subsystems of the vehicle. 
The software group is also subdivided into two teams, Realtime 
control and Simulation. As its name implies, the realtime 
group works closely with the hardware group and is responsible 
for the data received, and for the total control of the rover 
during an actual run of the vehicle. The simulation team has 
almost no physical contact with the vehicle, although all of 
the programs that analyze the incoming data and select the 
path of the vehicle are created by this group. Through the 
use of many sophisticated and complex mathematical models, 
runs of the rover are simulated on computers. 

2.1 Mechanical Hardware Description 

The heart of the rover (Figure l) is a box that con- 
tains a microprocessor which controls wheel speeds, analyzes 
vehicle attitude, and interfaces with the telemetry link. All 
of the power sources for the vehicle and the gyroscopes are on 
this box. The box or body of the vehicle is supported by four 
wheels each independently powered by a l/6 HP motor. In this 
configuration, the rover has a very good mobility. It has the 
ability to traverse level ground at approximately 0.2 meters 




per second and can negotiate thirty degree slopes. The wheels 
were designed for the rover; each is one -half meter in diame- 
ter. On level ground this permits the vehicle to handle 0.25 
meter steps (on slopes this figure decreases until at a thirty 
degree slope no obstruction would he tolerated) . 

The front struts of the vehicle are joined to the main 
frame such that each of the front wheels may be raised or low- 
ered individually; thus the front wheels do not significantly 
affect the "tilt" or roll of the vehicle. This is determined 
solely by the roll of the rear wheels. 

Directly between the front wheels is located the el- 
evation/scanning mast. This mast contains the lasers and sen- 
sors of the short range detection system. The mast rotates in 
a contra-clock-wise direction with a period of about two sec- 
onds. A mirror at the top of the mast also rotates in an 1 up- 
ward direction making a complete revolution twelve times 
per second. 

2.2 Electronic Hardware Description 
The "eye” of the vehicle is the laser/sensing scheme 
located on the front center of the vehicle. All of the hard- 
ware associated with this scheme is known as the elevation 
scanning (laser/multi-detector) mast (Figure 2). At the very 
top of the mast is a rotating octahedrally sided mirror. This 
system simulates the firing of up to thirty-two lasers using 
only one laser and the mirror arrangement. 

A gallium arsenide 100 watt laser is pulsed from be- 
low the mirror onto one of its faces. As the mirror turns. 




the incident angle of the "beam and hence the reflected beam 
are altered. By controlling the speed of rotation of the mir- 
ror and timing the laser pulses, it is possible to fire "las- 
ers” to sweep out thirty- two different elevation angles. 

Near the base of the mast will eventually be fourty 
photo-detectors (there are twenty in place at the present 
time) . The detectors are arranged such that they cover all 
of the terrain that would be swept out by the lasers on level 
ground. 

While an actual Mars vehicle would have an on-board 
computer capable of analyzing the elevation scanning mast data, 
most of the computing power for the RPI rover is provided 
through the use of a two-way telemetry link to a Prime 650 
computer. The terrain laser/sensor data, as well as all of 
the pertinent vehicle attitude and status information is sent ' 
to the Prime, and the vehicle commands are sent along the same 
link to the rover. 


2.3 Realtime Software 

The realtime software is concerned with getting the 
data in from the craft, analyzing it, and sending additional 
commands back to the rover. The data flows in along the tel- 
emetry link. This data is translated through an interface 
board and placed in buffers for use by other routines. The 
initial program is one of the most important since it has the 
direct link to the vehicle. 

The data in the buffers is just what was sent by the 

vehicle: laser/sensor data and vehicle attitude information. 
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The laser/sensor data is used by the modeler. This is a rou- 
tine that tries to recreate the terrain in front of the vehi- 
cle. Attitude information is used in "both the modeler 
and the path selection algorithm. The output of the modeler 
and path selection algorithms are used to generate the commands 
that are sent hack to the vehicle. Since the modeler and path 
selection algorithm are common to both realtime control and 
simulations, these will be examined in more detail in a later 
section. 

2.4 Simulation Software 

The simulation team has a difficult problem: it does 
not have a vehicle or terrain from which to get data. These 
must be "created" before anything else is attempted. The Sim- 
ulator in its present state has evolved over many years and is 
quite complex. There are routines that create the terrain and 
simulate the vehicle and its laser/sensor system. Other pro- 
grams move the "vehicle" over the terrain toward its target. 

The created landscape may have boulders, cliffs, craters, crev- 
asses, hills, or blocks. The overall terrain itself may be 
level, sloped, or have a rolling base. In addition to this, 
noise may be added to corrupt various parameters, simulating 
rubble or small rocks that may litter the view. The simulated 
terrain may be made to be very similar to an actual martian 
landscape. The modelers and path selection algorithms used 
in realtime control are developed and tested on the Simulator. 


2.5 Data Collection and .Analysis Path 


The new heading commands that are sent to the rover 
are generated within the path selection algorithm. The path 
selection system however consists of three separate and dis- 
tinct subsystems s the data collector (sensing system), the 
modeler, and the path selection algorithm. 

2.5.1 The Sensor 

The sensor must employ some means of gathering in- 
formation about the surrounding terrain. There are several 
approaches that may be used. A complete video system would 
be able to see everything, but analysis may prove to be much 
more difficult than a simple range finder. A video system 
would probably be suited for the long range hazard detection 
mentioned earlier. The EPI rover uses the laser/sensor scheme 
to gather the near field information. The hardware for this 
was described in section 2.2. The sensors have a set cone or 
field of vision which samples the line segment formed by the 
laser beam/sensor cone intersection. The laser/sensor inter- 
section points for a system using thirty lasers and forty de- 
tectors are shown in Figure 3* 

Analysis of such a system very quickly becomes com- 
plex. A three laser, four detector arrangement is shown in 
Figure 4 to illustrate how this system works. Each laser 
pulse intersects each detector cone once forming twelve line 
segments of intersection. If the terrain is present within 
any segment, it will scatter the laser pulse. The sensor as- 
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sociated with that segment will detect a portion of the en- 
ergy from the diffracted "beam, provided the path from the las- 
er to the ground and hack to the sensor is clear of other 
obstructions. Ideally, for each laser fired, one sensor will 
see it. Should none of the sensors detect a pulse, the path 
from the ground to the sensor must be blocked, and a "no re- 
turn" condition results (Figure 5 ) • 

2.5.2 The Modeler 

The data that comes from the sensor mast must then be 
analyzed. This data enters the terrain modeler - a special 
processor the "recreates" the landscape in the foreground of 
the rover. The modeler is perhaps the most important routine 
of the path selection process; if the terrain is reconstructed 
improperly, an obstacle may be overlooked, and an unsafe path 
for the rover to follow may be chosen. Alternatively, spot- 
ting hazards that are not present may force the vehicle to de- 
tour far from the desired course. 

This reconstruction is not as simple as it first ap- 
pears. In Figure 6, using the three laser, four detector sys- 
tem, several possible terrains are shown that would give iden- 
tical returns to the sensor configuration used on the vehicle. 
It is the modeler's responsibility to incorporate vehicle at- 
titude information with the appropriate hazard definitions 
into the sensor data. The output from the modeler would be the 
location of hazards to be avoided by the path selection algor- 
ithm. 
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The path selection algorithm accepts as input the 
range and location of possible hazards. The path initially 
calculated is the direct line to the target from the present 
location of the vehicle - as if no obstacles are in its path- 
way. If the path were clear, this is the heading that the 
vehicle would take. If hazards are present, the selection of 
paths becomes much more difficult. The analysis of steering 
angles and rear wheel movement as well as other factors must 
be considered. Without going into detail, the path select- 
ion algorithm chooses a heading angle (if one exists) which 
is nearest the desired unblocked heading that avoids all of 
the flagged hazards. 

While selecting a path, constraints are placed on the 
future available steering angles based on the location of 
noted hazards. Until well behind the vehicle, although these 
obstacles are out of sight, they pose a hazard to the vehicle. 
The constraints placed upon the steering angles prevent the 
rover from striking an obstacle located to the side of the 
vehicle when it is no longer visible. 




THE TERRAIN MODELER 


3.1 Historical Review 

In May of 1976 Mar jam Kr&jewski submitted, a report 
that "began the initial investigation into the development of a 
terrain modeler for the planetary rover, In this report three 
slightly different configurations were compared against each 
other: a single laser-single detector system, a two laser- 
single detector system, and a three laser-three detector sys- 
tem. His recommendations were to employ more lasers and sen- 
sors, include vehicle attitude information, and develop a more 
sophisticated pattern recognition scheme. 

It was quickly recognized that indeed many lasers and 
detectors would provide more detail, but that this would re- 
quire some very complicated interpretive software. The single 
laser-single detector system was installed on the vehicle for 
testing other concepts, meanwhile work was begun on better path 
selection algorithms as well as terrain modelers that would be 

able to handle a multi-laser/multi-detector system. 

2 

A report by Gary Maroon in 1977 presented a numerical 
technique for the estimation of slopes. His paper was mathem- 
atical in nature; it did not present a terrain modeler, but 
layed the foundation for work that was to be done by Nick 
Troiani. Most of his work dealt with area-slope calculations; 
however obstacles such as boulders an d craters wreaked havoc 
on his slope estimations. Early experiments indicated that 


the characteristics of different terrain features often over- 
lap, creating difficulties in determining hazards. 

3 

1978 was the year that Troiani completed his work on 
a usable modeler using Maroon's study as a framework. Certain 
calculations were simplified and improved; the sensor geometry 
was altered to form a "quasi-linearized" array of laser-sensor 
intersection points. This modeler detected most large posit- 
ive (boulders and uphill slopes) obstacles, but did not do 
very well in the classification of negative hazards (craters), 
nor did it consider cross path obstacles. 

Using the same slope equations used by the previous 
modelers. Erwin Hunter. refined Troiani 's modeler and imple- 
mented a crosspath analysis to detect very large obstacles 
that would affect the roll of the vehicle . Negative hazards 
were still not readily detected, slope estimates were good to 
within ten degrees, and slopes with obstacles continued to 
create problems for the area-slope manipulations. Although in 
the very near field (less than 0£ie meter) objects were easily 
identified, this did not leave the vehicle enough time to a- 
void small obstacles. 

The modeler in this paper for the most part, discards 
all of the attempts made using the area-slope estimates and 
starts again from Krajewski's initial work. A thinning al- 
gorithm reduces the quantization errors that prevented pre- 
vious modelers from identifying terrain steps. A dual first 
order filter separates the problem of slope and height est- 
imates into two parallel paths of analysis. The crosspath de- 



tection algorithm eliminates the dangerous possibility of tip- 
ping the vehicle to either side. 

3.2 Definition of Hazards 

Before any further description of the modeler is pre- 
sented, an examination of exactly what constitutes a hazard 
would be beneficial. In section 2.1, the wheels of the rover 
were described to be 0.5 meters in diameter. Because of this, 
steps greater than 0.25 meters in height are considered to be 
hazards. Steps of that height cannot be negotiated without 
forcing the wheels of the vehicle to travel only in a verticle 
direction (Figure 7). 

The slope hazards have been set at thirty degrees for 
both uphill and downhill travel. The reasons for this depend 
upon the size of the motors used and the stability of the veh- 
icle. Although more powerful motors could force the rover to 
negotiate the steeper slopes, the location of the center of 
mass would be altered, and the stability of the vehicle becomes 
very low. This would increase the chances of the rover tipping 
onto its side. If this were to occur on Mars, its mission 
would be essentially ended since in all likelihood, the vehi- 
cle could not right itself. The same reasoning for the inpath 
slopes also holds true for the crosspath slopes. Thus, the 
roll of the vehicle must be kept below thirty degrees. En- 
ough of a safety factor has been built into these figures, 
such that, if these constraints are followed ( 0.25m step, 30° 
slopes) the rover should always be in a stable attitude. 


19 





3.3 Description of the New Modeler 


The terrain data collected by the sensors is essent- 
ially in the form of height/range information. It can be seen 
from the previous examples of the terrain possible for one 
given set of returns, that this data is limited in accur- 
acy by the finite dimensions of the intersection line seg- 
ment formed by the laser beam and the detector's cone of vis- 
ion. The accuracy of the return is dependent on several var- 
iables. As expected, the first of these is the range at which 
the intersection occurs. In general, the further from the 
- vehicle that the terrain is observed, the larger the inter- 
section segment. The other two variables that affect the ac- 
curacy are the separation distance between the laser and de- 
tector assemblies, as well as the detector's cone of vision. 

The job of the terrain modeler is to reduce these uncertain- 
ties from the laser/detector system to tolerable proportions, 
recreating the most probable terrain from the data. 

3.3*1 The Filters 

There are several types of hazardous terrain, each of 
these will be discussed in turn. The two major classifications 
of hazardous terrain are steps and slopes. This modeler rec- 
ognizes that the steps and slopes can be distinguished by 
noting that steps would appear over only a few terrain samples. 
The data samples ordered in increasing range from the rover 
would have an almost constant height value until the step is 
encountered. At this point, the height of the terrain would 
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suddenly shift to another value. Slopes on the other hand, 
would appear over many samples (long slopes would appear over 
the entire in-path scan) , Each succeeding sample from the veh- 
icle would have only a slight change from the previous return . 

Recognizing this, the inherent inaccuracies of the 
individual data samples could he greatly reduced, while pre- 
serving the pertinent feature information by passing the 
height and slope data through separate filters. The estimated 
terrain height would be obtained by lightly filtering the data. 
That is, a quickly responding filter would be used to preserve 
the presence of step changes. The estimated slope of the ter- 
rain would be obtained by heavily straining (using a more 
slowly responding filter) all the data. This would prevent 
sudden steps or singularities from appearing in the slope es- 
timates unless they were extremely large obstacles (in which 
case they would be easily spotted by the height analysis). 

This in itself eliminates a major source of error that was 
found in the earlier modelers. The output of each of these 
filters could then be examined for its own particular kind of 
hazard. 

The data from the elevation scanning mast cannot be 
filtered as it is collected since the raw data is the same for 
both steps and slopes. Once in the modeler, the data can be 
filtered by different algorithms. The dual filtering concept 
is impemented using the following equations (beginning with 
the second data point in an azimuth) : 



I 


New Height Estimate = (1 - a)X( Current Sensor Sample Height) 

+ ( a )X (Previous Height Estimate) 


Current Comp- 
uted Slope 


= tan 


New Height Estimate - Previous Height Estimate 
Current Sample Range - Previous Sample Range 


New Slope Estimate = (l - j3)X(Current Computed Slope) 

+ ( p )X(Previous Slope Estimate) 


By controlling the parameters a and |3. (the height and slope 
filtering coefficients), the degree of filtering may be al- 
tered. The equations for both the height and slope filters 
are identical. In each case a value of 0.0 for the coeffic- 
ient would essentially remove that filter from the data's 
path; there would be no filtering and each estimate would 
take on the current sample value. Conversely, if the coeffic- 
ient were to have the value i.0, perfect filtering would oc- 
cur; the value of the initial sample would be given to each of 
the successive estimates. 

These equations form the first order digital filters 
which effectively decouple the step and slope hazard identi- 
fication problem. Although somewhat crude, they do an admir- 
able job estimating the terrain features. Higher order fil- 
ters were tried, but no real noticable difference was observed. 
Since these equations were more complicated, they required 
more calculations (and hence time). The additional calcula- 
tions performed were deemed unnecessary and outweighed the 
questionable gain over the first order scheme: they were el- 
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iminated from further consideration. 


3.3.2 Initial Processing 

Before each min, a "look-up table" is generated of 
every possible laser/sensor cone mid-point intersection point; 
this table contains the height and range from the vehicle of 
each intersection point (Figure 8). Since it is not known 
where within the cone the terrain fell for any given sensor 
return, the mid-point is used to minimize the error (other 
modelers used either the top or bottom edge) . This look-up 
table will be used in the modeler. 

Every time a laser is fired, each sensor responds 
with a 'O' (no detected pulse) or a '1' (pulse detected). 

Each laser has been assigned an identification number (from 1 
to the number of lasers), as have each of the sensors. When a 
laser fires, the number of the laser as well as the number of 
the sensor that saw the return are encoded at the vehicle and 
sent to the computer. Thus, at the end of one azimuth, a one 
dimensional array has been formed: the rows are the number of 
a laser, while the sole entry of a row is the number of the 
sensor that saw that laser. At the end of an entire scan, 
there are as many of these one dimensional arrays as there 
were azimuths. If each of these arrays were placed next to 
each other, a two dimensional array would be formed: the rows 
again would be the number of a laser, the columns would be the 
number of an azimuth. An entry of the array in the ith row ? 
jth column would be the number of the sensor that saw the ith 



Figure 8. Laser-Gone Intersection Points (Example) 


■M3’ 




i- 

r c ; s I- c r, •: 

.w — 

:j — 

Z - 

r 

? m A 

I- *J 

a 

v 3 r: 



— 

u c i rj ci :i rj :i ri 

ci 

:j cj 

r i r. 

— 

— 

— — 

— 

— — 

j T ■ “ 


vT 

7c:i-i- - t**. -r 

•*- r- 

:i — 




1- c 

i“. 

m r.- :i 

5 | • 


— 

ri ci :j a :i cj :i ci 

• 1 CJ 

CJ CJ 

-j eg 

-- 

— 




r !i . 

r ' 


CO 

© c :i- i-cttc 

1- eo 

:i — 

— ^ 


c 

I- < 


<C 3 CJ 

| 


”" 

cm cm :i cj ri ci ri ci 

• 1 CJ 

:i cj 

:i cj 

— 



— 

— — 

i, 



O' cr : i- i- -7 l: c 

-c c 

n — 

c* c 

£. 

3 

!- 'C 

o 

M- 3 C) 

(■ ij ; 



n ci n cj n cj cj cj 

ci eg 

n cj 

:j cj 


— 




;' i i 


ro 

O' O' 3 »- n o ^ 

-c r: 

ci — 

S 0 

O' 

cc 

1- W 

L" 

^ n r) 

ir 



cj cj n cj ri cm r j cj 

-1 CJ 

Cl CJ 

fj f: 

— 



“** 

— -* — 

i 


CM 

© © r t- n o © -c 

*c c: 

ri — 



3 

1- VC 

uz> 

+ CO CJ 

| , , 


«— * 

cj cj cj cj n cj ci cj 

Cl CM 

Cl CJ 

cj ci 

— • 

— 


-* 

—• — 

| l 


-H 

3 c 3 r- o lo 

^ 3 

cj — 

C 3 


3 

gc 

LO 

CO CJ 




rj cj m cj ri cj ci o 

“1 CJ 

ci cc 

Tj cj 

— 





f- 

=3 

© 

i- r- r- r- i- o to © 

*• 3 

CJ — 

c c 

o 

c 

N •'C 

© 

rr CO Cl 

i. 

*-« 


CJ Cl Cl CJ Cl CM Cl CM 

ci CJ 

Cl CJ 

Cl Cl 


— 


— 

— “ • — 


E 











f > 

«— 

© 

N K f- J- OCC^ 

* 3 

Cl — 

c* c: 

© 

3 

r- v= 

lO 

^ CO CJ 

L . , 



ci cj ri cj ci ci ci ci 

Cl CM 

CJ CJ 

n cm 

— 

— 



*— — ■ — 

! 













< 

3 

n r- r- r- r- © io m- 

"C 3 

:j — 

C' c 

ON 

c 

1- ^ 

LO 

Cl Cl 

! fV1 



Cl C) Cl CJ Cl CJ Cl C) 

Cl ci 

:i cj 

Cl Cl 

— 

— 


— • 




N 

3 3 3 t- 1- *w LO 

© 3 

n — 

c- c 

ON 

3 

h- vc 

LO 

V CO Cl 




ci cj :i c) :i o ci cj 

Cl CJ 

Cl Cl 

CJ CJ 

— 


— * — 

“* 




© 

CC3t- 

'M' 3 

At ^ 

o c: 

© 

3 

J'- vC 

LO 

^ CO CJ 




ci cj :j cj ci cj ci cj 

Cl CJ 

Cl CJ 

Cl CJ 





r- —* *— 



LO 

c o 3 r- n c w tj- 

^ 3 

Cl — 

o c 

© 

C 

h- vc 

IDTj-OfJ 




Cl Cl Cl CM Cl CJ Cl CJ 

ci eg 

Cl Cl 

Cl Cl 


— 


— 

~ w 



•* 

O' c c r* N ••£ LO M* 

M* cc 

CJ — 

o c 

C'CCN'C 

uo 

t7c:j 

; 



Cl CJ Cl CJ Cl Cl Cl CJ 

ci CJ 

CJ CJ Cl Cl 

— 

— 

— 1 — 


*■“ 

| 



C C 3 t- N W v 

^ ZZ 

Cl — 

o c 

cer-'c 

LO 

■TT CO Cl 

’ 1 


* 

Cl CJ CJ C) Cl CJ Cl CM 

Cl Cl 

Cl Cl 

Cl Cl 

— ■ 


^ ~ 


^ ~ ~ 

f 


cm 


tJ* C7 

Cl *- 

© c 

© c 

N 

to 

Tj- CO CJ 


- 


ci ci d co ci ci ci cj 

ci CJ 

C1 Cl 

Cl Cl 

— 

*— 



^ F-» 




c c r t- n c o v 

'V' co 

Cl — 

© c 

© 

3 

N vc 

LO 

g* CO Cl 




Cl CJ Cl O) Cl Cl Cl Cl 

Cl Cl 

ci eg 

Cl Cl 


— 

— . — 

— i 

^ ^ 


c::i*CTr. 

c c ci- i n 

c c X i- ^ -c 3 

c C' d* *c ^ r: 

c^Ci-ctc 
c © 13 t " r5 

c c> cc f- c ^ ^ 

© © 3 i - sc -*• ro 

c o w t- c -t r. 

c c ^ 

C C" ~ I- C *t 75 

c O' C r- C rj- 

C © 2 I- O Tj* 75 


o o> c r- o l: ^ r: n « o O' o h 

3) C) Cl Cl M Cl Cl CM Cl CM Cl — — — 


OL7^ttN'-OCONCL'5^r5 0) 


§«®*i«§ 8 aS§g 5 §g; 2 J: 2 SJ 5 £!:: 


C O N o v O 


§cldCjSSo}fjcj^^^ 2 ^S 2 ^ 22 llS CNC " NvClc T c:)Cvi 


H 


nJ 

fC 

C 

-P 

o 

3 

•H 

S 

03 

T-J 

3 

N 

0 

c 

G 


•H 

0 

Q 

3 


O 

0 


3 

>» 

O 

rQ 


laser along the jth azimuth (Figure 9 ) • 

The data from the sensors enters the modeler one az- 
imuth at a time. Thus, the information in the first column of 
Figure 9 is examined before the second column. The modeler 
now knows which sensor saw which laser. From the look-up 
table, the approximate range and height of the terrain are 
found. The data points for an azimuth are then ord.ered in 
terms of increasing range from the vehicle. 

Before proceeding through the dual filters, a thin- 
ning algorithm is used to eliminate closely spaced data points. 
This reduces the effect of quantization errors frequently en- 
countered near terrain steps. This is especially important 
when the slope estimates will be made (Figure 10 and the slope 
filter equations) . 

A quick test for extremely large obstacles is then 
performed along each azimuth. If fewer than half of the fired 
lasers were observed by the sensors, or if the range of the 
furthest intersection point is less than 1.5 meters distant, 
there is clearly an unusual and most likely hazardous terrain 
feature present (the sensors are able to detect a laser pulse 
up to 5.0 meters away). Should this "be the case, the entire 
azimuth is flagged as hazardous. If an appropriate number of 
sample points remain after the thinning algorithm, the dual 
filtering process is begun (a sample of raw data returns and 
the new data set formed by the filters is given in Figure 11). 

The new data set from the height filters is examined 
solely for sudden steps in both the positive and negative dir- 
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Figure 10. The Effect of the Thinning Algorithm 
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ection. Any hazardous slopes that exceed the safe limits are 
detected from the output of the slope filter. Before the ex- 
amination of either data set takes place, the attitude' of the 
vehicle is taken into account. 

3 . 3*3 Inpath Analysis 

The attitude of the vehicle is used in the slope es- 
timates to determine what the attitude of the vehicle would be 
if it were to travel along a given azimuth. The current vehi- 
cle attitude also affects the size of the step that the rover 
may be permitted to take. If the total inpath slope of the 
vehicle is less than 2/3 the maximum permitted (twenty degrees) , 
then the full step size of 0.25 meters is traversable. If 
the vehicle is on a slope greater than twenty degrees, but 
less than twenty five degrees (5/6 maximum) steps of 0.12 met- 
ers may be safely handled. Vehicle attitudes of twenty-five 
to thirty degrees dictate a maximum step size of 0.06 meters. 

The rationale behind these changes in the hazard definition 
for steps may be seen in Figure 12. 

Data returns from greater than 3-5 meters distant 
are ignored since the line segments of intersection begin to 
become large (review Figure 3) . Any steps that are larger 
than the current hazard definition are flagged as dangerous, 
as are slopes that exceed the -thirty degree definition. The 
azimuth and range at which the hazard is detected are stored in 
memory for further use. 
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3.3*4 Grosspath Analysis 

The modeler has an algorithm to determine crosspath 
hazards. All previous modelers had the ability to detect most 
hazards along an azimuth, but only one even attempted to check 
for crosspath obstacles. The modeler discussed here uses fewer 
calculations, is more sophisticated in its hazard determinations 
and gets better results than the earlier attempt of crosspath 
analysis . 

The problem of crosspath hazards can be clearly seen 
in Figure 13. The figure shows a positive step located adj- 
acent to a hole. The inpath scans of the terrain are suggest- 
ed by the azimuths 1-4. In the first two azimuths the terrain 
drops 0,20 meters at some distance from the rover. Azimuths 
three and four show a sudden jump of 0.20 meters at the same 
range from the vehicle. Each azimuth taken individually in- 
dicates that there is safe terrain ahead of the vehicle when, 
in fact, this is not the case. If the terrain were sampled 
just after the discontinuities and examined, the terrain as 
suggested by the crosspath would bo reconstructed. Obvious- 
ly should the rover elect to travel op this 'hill, it would 
be extremely unstable and would probably tip over. 

Although exaggerated, this figure graphically shows 
the crosspath problem. As the data is being filtered, var- 
ious data points are "picked off” for the cross path analysis. 
These points are spaced at approximately 0 . 2j5 meter intervals 
beginning at 1.25 meters from the vehicle along each azimuth. 

The overall analysis (both inpath and crosspath) forms a grid 
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A) Terrain viewed from rover along four azimuths (arrows point 
away from the vehicle). Step (on left) is adjacent to hole. 
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B) "dde view of the same four azimuths shown above (Height vs. 
Lange). No hazardous terrain can be found if only the in- 
path returns are examined (arrows again point away from the 
rover) . 


% ?3 

~-e- 4 

C) "Reconstruction" of the 

crosspath terrain using the pointsX 

P^-P^ from part A. This type of 

analysis shows a hazard that the -p 2 •? 

rover would not be able to negotiate - it was entirely missed 
by the inpath search for obstacles. 


Figure 13 . Grosspath Hazard Illustration 
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as shown in Figure 14. 

A careful examination of the crosspath slopes is of 
more importance than that of the iripath slopes since it is act- 
ually easier to tip the vehicle sideways than to tip it back- 
wards. The analysis however is basically the same. The safe 
step size is massaged depending on the actual roll or cross- 
path slope of the vehicle. 
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Figure 14. Lines Examined 
by the Modeler 




PART 4 


PROPOSED COMPUTER SIMULATIONS 

Once the appropriate values of alpha and beta are 
selected, the results of this modeler are expected to be more 
descriptive of the terrain in the vicinity of the rover than 
any other previous modeling scheme. To test the abilities of 
the modeler, a series of computer simulations are to be run. 
The first phase of these runs are to be performed under "lab- 
oratory" conditions . Exactly hew the rover approaches an ob- 
sracle will be under "manual control"; that is, no path sel- 
ection algorithms are to be used. A predetermined course 
will be followed. The rover will traverse level ground only - 
there will be no pitch or roll. This type of environment will 
present repeatable results showing just how the terrain is be- 
ing interpreted by the modeler. 

Although the hazards have been predefined, the rover 
may not interpret the terrain as expected. From these initial 
tests, what the rover is seeing will be examined and the par- 
ameters of the filtering equations will be determined. The 
remainder of the runs will pose various problems to the in- 
terpretive abilities of the modeler over a range of simulated 
terrains. The path selection algorithm will be fully active 
during these more normal or "field" conditions. The rover 
will be expected to maneuver around obstacles placed in its 
path. 

One of the major additions to the modeler is the 
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capability to detect hazards that are across the path of the 
vehicle. The vehicle will be given different rolls and/or 
obstacles that must be examined for crosspath hazards. Hav- 
ing tested how the roll affects the vehicle, the pitch will 
then be tested using a sinusoidal terrain. The terrain will 
be designed such that it is always traversable. The most im- 
portant reason for the existance of the modeler is of course 
the avoidance of obstacles such as boulders and craters. This 
then is to form the next series of simulations. Since the 
roll and pitch have essentially been tested individually, the 
vehicle is to have both a pitch and a roll during some of 
these runs. Finally, if all goes according to plan, all of 
the preceeding tests will be combined into several difficult, 
realistic terrain simulations. These will be designed to test 
all of the modeler and its integration with the path select- 
ion algorithm, detection, classification, and avoidance of 
all types of hazards on a surface comparable to the martian 
landscape. The entire testing sequence is shown in Figure 
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Figure 15 . The Proposed Testing Sequence 


SIMULATION RESULTS 


5.1 Determination of Alpha and Beta 
The first phase of computer testing examined how the 
filtering equation parameters affected the performance of the 
modeler. In each of these tests, the rover would advance al- 
ong a straight line toward its target. Located immediately 
"behind the target was an obstacle of one particular type: a 
boulder, crater or slope. Since these obstacles were not in 
the pathway of the vehicle, they would never prevent the rover 
from reaching its destination. 

At first glance it might appear that such tests have 
little value; looking at only the final output maps, they 
would indeed seem to serve no purpose. However, in many cases, 
the most useful data is not in these final maps, but from the 
intermediate data and decisions from the modeler or path sel- 
ection algorithm. By setting certain flags, all of the inter- 
mediate data from the modeler was presented for observation. 

This information included all of the initial heights and ranges 
(of the laser/sensor intersection points), as well as the out- 
put from the dual filters. Careful study of this massive out- 
put of data permitted an indepth understanding of how the mod- 
eler "saw” the terrain feature as the rover neared the obstacle. 

To examine how the height estimate depended upon al- 
pha, the vehicle would approach a boulder of a safe height. 

Since the height parameter alpha is independent of the slope 


parameter beta, the latter was fixed to a single value for 
these tests. The rover would approach the same boulder along 
the same path for several simulator runs. Only the height par- 
ameter in the filtering equations was a variable. Following 
these simulations, a boulder that was considered unsafe for 
the rover to climb was substituted for the previous rock. 

Each of the earlier runs was then repeated. Examination of 
the intermediate data for all of these tests revealed a range 
of alpha for which the safe boulder would appear safe, and the 
unsafe boulder would stand out as a hazard. 

The same procedure that was used for boulders was then 
applied to safe as well as 'unsafe craters. With alpha fixed 
to a single value, and beta as the variable, each of the above 
simulations was repeated for safe and unsafe slopes in both the 
uphill and downhill directions. Each of these groups presented 
a range for alpha or beta that would appropriately classify the 
hazard associated with that parameter. 

The range of alpha for boulders was then compared to 
the range of alpha for craters. From this a smaller range of 
alpha was found that would properly classify the height obst- 
acles. Similarly, the range of beta for uphill slopes was 
compared with that of the downhill slopes establishing an- 
other range for beta that would classify slopes. The values 
selected for alpha and beta from these final ranges were 0.25 
and 0.90 respectively. These were used in all of the remaining 
simulations . 
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5.2 Obstacle Glassification 


Using the chosen values of alpha and beta, a table of 
how the modeler sorts obstacles was established. These are pre- 
sented in Table 1. The steps are discemable to within a few 
centimeters and slopes to within one or two degree. A few 
points should be clarified here concerning Table 1. A 0,24 
meter boulder, or a 0.26 meter crater may occasionally be clas- 
sified as unsafe or safe respectively. This depended upon its 
exact location as the rover approached. The fault of this is 
not really due to the modeler, but to the geometry of the las- 
er/sensor system. Two solutions to this problem are possibles 
a) the rover may be slowed down to allow more scans of the ob- 
stacle as it was approached, or b) increase the number of las- 
ers and sensors to get a clearer picture of the obstacle. 

Although the unsafe craters were seen for each of 
these runs, invariably they would be noticed at a closer range 
than unsafe boulders of similar dimensions. This problem will 
never be alleviated; it is inherent in any type of terrain de- 
tection system. Consider the following analogy: a one meter 
fence post is located five meters from an observer. Even at 
that distance, a fairly good approximation could be made of its 
height. If instead of the post there was a posthole, the ob- 
server would have no idea what-so-ever what the depth of the 
hole might be. The observer would have to move toward the 
hole to get a feeling for its true depth. Although somewhat 
extreme, it illustrates the problem of detecting negative haz- 
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Figure 18. Rover approaching a slope near the 
hazard definition. With just slightly less 
information than that needed to determine if 
the slope is safe, the modeler recreates the 
terrain to the right - an apparent "boulder 
(shaded area is the step hazard definition) 



The classification of "slightly hazardous" terrain 
for the twenty-eight degree slope can "be understood when the 
data from the sensors is examined as the rover approaches the 
slope (Figure 18) . The terrain is seen as safe up to the fin- 
al scan that the rover makes just before it gets on the slope. 
Since at this point it still appears as though there were a 
large boulder in its path, the modeler declares the path as 
unsafe, and the path selection algorithm moves to avoid the 
obstacle. This situation occurs only when the rover nears a 
sudden very long slope (or as will be seen later, extreme var- 
iations in the terrain) . Short slopes with the same degree of 
incline pose no problem. Once entirely on the slope the mod- 
eler had no difficulty determining the actual terrain. 

5.3 Grosspath Results 

While it is clearly important for the rover to be 
able to ibjects in its pathway, certain hazards may be 

overlooked if only one azimuth at a time is examined. These 
are collectively known as crosspath hazards. It is entirely 
possible to have safe steps along the inpath direction which 
are hazardous in a crosspath sense. Several examples of this 
problem are depicted in Figure 19 . The data from the mast is 
taken along one azimuth at a time and is processed for inpath 
hazards. It is only after all of the azimuths have been ex- 
amined (one full scan) that enough data exists for the cross- 
path analysis. 

The next several pages contain simulation results of 
obstacles that would present crosspath hazards. Figure 20 is 


the "control" of Figure 19A. In this run, the ground is lev- 
el; the rover is aimed toward its target in a manner such that 
its left wheels would roll into a crater and its right wheels 
would roll over a "boulder if its path were not altered. Since 
the overall roll of the vehicle was less than the thirty degree 
hazard , the rover did not change its co’urse and proceeded dir- 
ectly toward the target. If the overall roll of the vehicle 
was to become greater than thirty degrees along an azimuth (as 
would be the case if the boulder were higher and the crater 
deeper), a crosspath ha— .rd would be observed. To avoid an un- 
safe attitude, the vehicle would be forced to alter its course 
(Figure 21) . 

In both of these figures, as in all other maps in 
this report, the location of the elevation mast (center of 
front wheels) has been highlighted by a heavy, double line. 

The motion of the rear wheels has been shown by a dotted and 
dashed line. Any obstacles have been outined in a single heavy 
line. A rough cross-sectional view of the terrain has been 
sketched at the bottom of each page. In order to bring at- 
tention to the obstacles and motion of the vehicle, some ter- 
rain information may have been painted out of the picture. 

Another crosspath hazard was shown in Figure 19B. . An 
initial control of this situation had the rover pointed toward 
its target with a 0.10 meter block in the path of its right 
wheels. The initial roll of tho vehicle was 0.0 degrees (lev- 
el ground). As expected, the rover had no difficulty neg- 
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otiating the block (Figure 22) . This experiment was repeat- 
ed with the rover on a hillside such that its initial roll 
was twenty degrees (Figure 23) . Again since the overall 
roll of the vehicle was kept "below the hazard level, the rov- 
er was able to move directly toward the target. It was only 
when the vehicle would have had to take on an unsafe roll that 
the rover was forced to detour around the block (Figure 24) . 

Although not explicitly shown, it should be clear 
that any crosspath slope less than that of Figure 24 would 
be classified as safe unless the obstacles themselves were lar- 
ger; this would once again force the rover into an unsafe at- 
titude. The crosspath analysis works equally well for slopes 
in the other direction, and obstacles do not have to be pos- 
itive steps (Figure 19G) . 

5.4 Sinusoidal Terrain 

Most of the terrain on the planet Mars is not going 
to consist of perfectly level ground, or abrupt smooth slopes. 
Instead, some type of rolling, varying hillside witn obstacles 
is more apt to be found. It is important to know how the rover 
would handle this type of terrain, or more specifically, how 
the modeler interprets the data received when the vehicle has 
a pitch and roll. The next series of simulations was designed 
to show what can happen if the terrain becomes too rolling or 
hilly. In these runs the rover will travel over a sinusoidally 
varying terrain base toward its target. The only variable will 
be the amplitude of the sinusoidal base, 
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Figure 22. Rover Negotiating 0,10m Block on Level Ground 
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Figure 23. Near Crosspath Hazard of an Uphill Positive Obstacle 
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Figure 24. Crosspath Hazard of an Uphill Positive Obstacle 
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Before these runs were executed, it was expected that 
the rover would decide not to traverse ground that it should 
have "been able to cover. The reasons for this can be seen in 
Figure 25- Here the rover is on a sine based terrain that it 
should be able to roll over without detouring. At various loc- 
ations below the main figure are drawn the raw data returns 
from the sensors. At point three, the terrain is declared as 
hazardous. This is because not enough information exists at 
that point about the ground (notice that the same terrain has 
been swept out by the lasers as the vehicle approaches point 
three, but there is no data on the land between points three 
and four) . As the terrain forces the pitch of the vehicle to 
become more and more violent, the "obstacles" (missing returns) 
that the vehicle sees become larger and more hazardous. 

Figures 26 - 29 show the results of these simulations. 
The terrain with a 0.2 5 meter amplitude is easily traversed by 
the rover. At a 0.30 meter amplitude, the vehicle first per- 
ceives an obstacle (Figure 27). As predicted, as the ampli- 
tude variations increased, the sensors detected larger hazards 
which the vehicle needed to avoid, until at a 0.40 meter ampli- 
tude (not shown), the rover become "lost". The path followed 
is the same as that for Figure 29, except once the rover moved 
off the top of the page, it never returned to the target. 

Returning to Figure 27 ( 0.30m. amplitude), it would be 
interesting to note how the modeler might interpret a few small 
obstacles placed ir. its pathway £ this was done in the next few 
simulations . 
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Figure 27. 0.30m Amplitude, 6.0m Period Sine Based Terrain 
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Figure 28. 0.35® Amplitude, 6.0m Period Sine Based Terrain 
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Figure 30. 


0.30m Amplitude, 6.0m Period Sine Based Terrain 
with 0.30m boulders 
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Figure 31. 


0.30m Amplitude, 6.0m Period Sine Based Terrain 
with 0.30m deep craters 






In Figure 30, small boulders were used, while in Figure 31 
small craters that were of the same size as the boulders were 
used. In each case, the rover easily avoided the o Debacles 
and proceeded to the target. 

Admittedly, a terrain with this magnitude of varia- 
tion is not expected to be encountered. If one examines photo- 
graphs of Mars, although it does have a rolling landscape, the 
variation is much slower. However, it was reassuring to note 
that the vehicle performed as well as it did during these test. 
Since a varying terrain such as that used in these simulations 
is not expected, the sensor system and modeler are satisfactory. 
If the vehicle were going to encounter terrain of this nature, 
several things could be changed to permit the vehicle to tac- 
kle the job. More lasers and sensors might be added to in- 
crease the range of sight of the rover (more sensors would 
probably do the trick) . Another possibility would be to oscil- 
late the sensor angles. On scan 1, the vehicle might look at 
ground 0.8 to 3«0 meters from the rover, scan 2 would cover 
the terrain from 2.5 to 6.0 meters; scans 3 and k would be the 
same as scan 1 and 2. Both of these possibilities are real- 
istic solutions. 


5.5 Obstacle Avoidance 

In the last few sinusoidal terrain simulations, some 
small boulders or craters were added to the landscape. While 
these small obstacles exist, in reality a more general mix of 
both large and small terrain features would be found. With 
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this in mind, the next task would be to set the rover moving 
through boulder- crater fields with varying obstacle sizes. 

Each boulder-crater field simulation was run several 
times. During the second run, "noise" was added to both the 
pitch and roll of the vehicle. Examination of the martian 
surface reveals not only the reletively larger obstacles that 
the modeler would detect, but a surface littered with smaller 
rocks and holes that would probably go unnoticed. The "noise" 
added to these runs corrupts the attitude of the vehicle and 
is intended to disturb the vehicle in the same manner as the 
actual rubble. This noise had a maximum deviation of plus or 
minus ten degrees with a standard deviation of from 3*5 to 4.0 
degrees. Figure 32 shows how this would change various terrain 
surfaces . 

All of the simulations had successful terminations - 
the target was safely reached. There were of course minor 
variations to the initial path chosen when the attitude noise 
was added, but essentially the same course was followed for 
each of the noisy runs. Since approximately the same path was 
chosen by the vehicle if the noise was present, in Figure 36 B, 
the noise was changed for the worse; for this run (and the next) 
the noise had a maximum deviation of plus or minus fifteen deg- 
rees with a standard deviation of 4.2 degrees. This type of 
rubble would really shake up the planetary rover, so it was 
really no surprise that the vehicle chose an entirely new path 
to follow. This run was repeated for a third time with the 
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5rnoo~fK -terrain 




Figure 32. Effect of noise on the terrain 
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Figure 33B. Boulder-Grater Field, 10° Attitude Noise 
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vehicle starting from a slightly different location. With this 
starting angle, the vehicle could not safely pass "between the 
first two obstacles. This was observed in the simulation, and 


although it initially began to move away from the target, the 
rover none-the-less proceeded on as short a path as possible 
toward its destination. 


5.6 Realistic Terrains 

The final simulations are fairly representative of 
the terrain that is likely to be found on Mars. Photographs 
of the martian surface were used in the creation of these land- 
scapes'. The output of each run is preceeded by a "three-dimen- 
sional" projection of the terrain used. This was done solely 
to provide a better grasp of what was displayed on the vehicle 
path maps. 

Figures 37A and 37B show a~iarge gaussian hill along 
with scattered boulders and craters that were placed in the veh- 
icles path. The destination was on the top of another hill. 

Ten degree attitude noise was added to both the pitch and the 
roll. The vehicle started toward the hill, but then changed 
course to avoid a crosspath hazard formed by the hill and a 
crater (the case not shown in the crosspath tests). The larger 
hill was slightly too steep for the vehicle to climb directly 
toward the target, but the hill was negotiated by reducing its 
pitch (veering toward the left) . A close up of the last eight- 
teen meters of this simulation are shown in Figures 38 (A and B) 
The last run (Figures 39A and 39B) again used the ten 

7 ^ 









in ** 

ti imivivii 


9993333933333333333j/ UUUIH I I I I»«u0 V) 33333333333333 (3 


3 JJ J J JJJJJJJ jjjjjjjji t«U 
•33333333333333333333* OOU 
SJJJJJJJJJJJJJJJJJJJi uo 
9 9 33 3 3 333 33 3333333 3 3 Jh O 
3 jjj jjjjajj jjjjjyjjjjAi 
3333 33333333333333333333V, 
33JJJJ2J3jyj3J.lJJJJJJJJJJ 


UUO | I I I I UMJ 
OUOI I I I I I (J Ot 
UUUWI I («uuu< 
ooouoouooo 


333333333.33.333 / . R 
33333333333333 f U 
♦33333333333333 1 M 
33333333233333 I .U 
333233J3333333 ! 3A 
33333333333333 f 3 V 
93 J3 333 3 3333 33 1 33 ' 
39333333333333 | 333 

3 33 333 3 3 33 3 333 t 333 
3JJJJ J JJ33JJ33 . 3J3 
3333JJ33333333 I 233 
3JJJJJ.UJ JJ J33 ! 333 
♦333333333333 * 333 

J3JJJJJJJJJ . / 323 

933333333 f 333 / 
3232 JJ .X 233 /, 

3 ' 339 /£ 


*333233333:1333333 
t.UJJJJ JJ.I3JJJJJJ 
13333333332333333 
JJJJJJJJJJJJJ 
33333333333 
J3J 33 3 / 


* 444*44444 

444444444444 
.. 444444444444i 
444444 4*44444 

4444 4 44444 

, 4444 444 

444 3933 4444' 

4444 3333333 444 

444 33339933 4444 

444 3332333333 444 

4444 3339 333 *44 

444 333 332 444 

4-*- 222 2222 *44 

444 333 333 444 

444 3333 3333 444 

444 233333333 • 444 

444 33933333 444 

4444 333333 444 




41.1, «.ll«44bt» t*** .£^6440406406*46** * \V l 4 ♦ M. 

U.M.l.Ul V. *41.4 

IMibbi . *4 -Vt 

M.M.4.C ^ * «■ 

ittitt * .S* N . ot* .w» t 

1.1, (.4, \ 0 0 U\ !* 4 

SjAr b^bbbbbbbbtt *. 441. \\ 6 

S/Cf # Ct,l,tl.U»t.ttl/*4444444V*^74U * ttt I |. I 

^'/y .(.bbbbbbbbbbbliliwv^y^lrvivvjb 1 *66 Jj l 
■ A? ,,'66l.<.*.6C6*6466oV<»%y'»VV4yVVyV ( *t J b 0 L l/|a 1 
y. s »ciiCbCbbi.4»ii>t,nwy'*yyyyyvy4/<>t * *66 Jf 4 
/ M.bCI.M.b«.bbbbttH>iS ^* l »4 '>4'</4Ui(- 000 it 4 

,/ «6*46o6*666660b6bb**lo7T>rTrfbb6<.(,6«'COC L H bl 

bi.f.i.bbf>«.r.hi.l.bb(.i l bi.bbbb<,UbbbbbLbi>MiUbab l 61 
C<ibb(ibbbbbbbbbbbbbbbUtULbblbbbb(itibl.bbbb jj bbl 
b4bl.bbbbbbblibM.bb(,(iblibUlilili(ibUi(iLbUt,bU ft bib 
4bb*bb*»bbtbbbbtbbbblibbl.br / v,bbbbbbbl>b| l 6i /f tllb 
bbbbbbbbb(,bbl<bbbbl.l.bbbbbabk(>b4l>bbabb // , Lbbb 


3 444 

4 444 
4444 
44444 
444444 


44444444444444 

44444444444 

44444444 


333 

33333 

333333 

33323333 

333303333333 


4bb*bb*»bbtbbbbtbbbblibbi.brfV,bbbbibbi>bi l 6i /r bUt 
bbbbbbbbbM.blbbbbl.t.bbbbbttbi-Ublil.Llbbb // , LUb 
bo664646bbbbb06*606bb464*bbbbb6b6 bblbb 

bbbt,bbbbbbbbbbbbbbbilibbbblil>bblilib4 i*^T. bbbbbb 
bbbfcbbbbbbbbbbbbObbitbbbbMibbbtU btbbun 

bfb«,kbbbf,bbbbbbb l bbbbbbb«.bl l bl l b(.bbbUI,UbbLI,U,bbtb 
bbbbbbbbbbbbbbbbbbbbtbb tbb bbblbbbblbbbl bbbbbbbbl 
bbb4bbbbbbbbbbbbbb*bbbbbbb«ibribblibM<f>b*<bb(ibbbbbbb 
bbbbbbbbbbbbb4bCbb4bbbbbbtib<ib«»be)>t,bebtUUlitbbb 
t, bbbbhbbbbbbbbhAbbbbblhbhbbbbbb 1,01.6 OOl. I, t, L, i, b, 06 0 66 
6 6 b bbbbbb b 6b606**O6b* bbbbbb bbbbbbbb b b 6 6 6 b 0 0 bbbbb 
bbbbbbbbbbbbbbbbbb4bbbbbbbbbbbbliM,bM>libbl4l>l,hbbbb 

0 60 6 6O0 6 066 6 0 66 6O6o<Kj9?>6 bbbbbbbbU>*bM<l.hhMbbbt 
bbbbbbLbbbbtbbbfcbba; . 3 )6bbbbbbb<> bbUbbbbbtbbblt 

b 000 b 66 b 06 b 0066006 </c 3f660060666666060».o#,44444 

6406*044666b66600640>6Wbb6b6660CC600066i l 606o6*6 
606664664 606 664660466 4 6666* OOOOoOOOOObOOObOoOoOb 
44G6664444C66666i,460b****t*bbt.666b66 6C6 6*6C6b606 
4606 06 66*06606606406**6**666666666066 66 M.660(**6t 

> tl>6tt b<tl i4b(ibli44bUUb4i*tt(,*bU»tttbbb»tbtbb*4** 
400Mr55>4li6664tO666*6**6*6b6 66 6666 66666666P.664*6 
C6C6 J 06b644C6666*4***6b*6b(i6466b666b6bbb4*6 

6b b L 3 Ub(lbb6b*4b»<.tb**b*t6th6666b6bt».6»».6bbtb 

’,^ /641bbbblbtblbbbbblibb6b6tbb6bbt6tbbb6*b 

G6G64604660060*660446<,**b4666*OOt.L6fet>I,6bb«>oC6 tb* 
6666b6b6bb6b6bb6bbb6b6b66bt66666bf bb66bb6bb«b6bb 
64GG6CCG6GGGGGGGC4G6GG4t*bG6bGbG66(,6b*66bbbb66b* 
OOOOOGOOOCGbotGfcfeGbbiiboibbbbbGobf'bbbbtiGOtibibb* 
GG&GG6G4G6GCGGGCG6CGG(<tGfcCGGGCGG66G6l,b».Gb6/,66G*t 
04fe0666O46466640666btC>b06eGO66bbft6 660OG6Gt.b6C6tL 
*GGGG6GGGfcCtGGGtGGGGG6GGGLt4GGGGG6GbtCGGU/<,6bcC4 




40060000600600060066 1 b^L2 >*. 

tTK^OobOCtOCtCbCCCOCf^/j " 

3 JJ'VibOOOOObbOOOOOtj/ 22222222 
3j\o 4 64 L b 6 L C6 GCC yj 222222223232 
32jB,46666«6b6t46i 223222222222 

3:t| 464b6G6GGGf.G{, 2222222222222 

333 l/>666666666666i 222222222222 

33 /l>6046C(>66b661,A 222222222222 

3 j/666466666666646k 222222222 

>»<464444fc6666666664K 222 y 


,3 >t,be66ebtie«6bU 

Jbblbbllb bttbb 

22222232 \bt.fc4.bbt,btbC 
2222222222 \b6t6tCb46b6 
.22222222222 liotcbbtfcbtt 
22222222222 fiCLCCCOcc 4 * 
22222222222 Ltbbbltbtbl 
2222222222 /oobootobbtt 

222222222 /6bC*bb 666* bb 
222 y^o 1 L L L C o o o o 6 6 C 


6666 66 4466 646 646 66666 bbtb^LLGLt, ttitttCoLCOCtl, 6 L 
6666660666 666666b6666bbbb6bbb6bbeebbt>bb6b00b 666b 
666666066666*r>66b66666bb*6«>6bGb<,Gb6CG6(,bG«,GGGGtG 
6 6606666666666666 664 bbbbbb 66 66 bbbbbb bbbbbb 66066 4 
6 66646664666666 6 66 666***66 66b b bb 1 6 b 00 (i 1 b 0 t C 00 66C 
6666466666 6 0 6 6 06 b*666bb60664bb 66*064460 *04066466 
066 6 66 666 66006666 666 66 6 44666 66 6 600 406 oLoObLobt 6 6 
66060666666 666046006 0666646666 C 66066 6 6666006 66b * 
666666666666666666 Oa 60*46666**66bb bbbbbOOOOOObOl, 
606646666666666666666666666666066466666 6000660 6 6 
6466 66666 6666666 664466646 6666 6 6666 666 6 66000 00 6 66 
66 0000*046 066 60 644660444b466b6600 6666 66 6 66b 66064 
OOOOOOOOOOOOOOOOOOAOoOOObbbOOO'SObOOOOObObAOOboGG 
6 bbb 66 44 4600660 464 *4 666664b 60 666*66466 66 6. 606664 
6 60 0 0 404 0 6 0000 00 0004 600 0000 00 000000 000 0 660 b OOO (.4 
04664666b666b666b6fa6666466bb46b6bbb66bbO6b6b666b 


4.72 . 1.42 

IXITIAI, VtlitCLE LOCATION 

D-muici: sehjJoh o^ckatioh 

-TT-S VUIICLE I'ATU 

“S. TaRCCT location 




Figure 373. Boulder-Crater Field, 
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degree attitude noise, but on a sine wave based terrain with an 
amplitude of 0.40 meters over a ten meter period. A 1.5 meter 
hill was added to the top of a crest of the sine wave; boulders 
and craters completed the view. A large bump on the side of 
the hill did not prevent the vehicle from arriving at its des- 
tination. 

5*7 Observations 

Each successive simulation posed a more difficult task 
to the modeler's interpretive abilities. Simple tests examined 
the reconstruction and classification of various terrain obsta- 
cles: small boulders, craters, and slopes that were near the 
hazard definition for that feature. The crosspath algorithm 
worked quite well, concluding the first phase of simulations. 

'With few or no obstacles in its pathway, how the rover 
would handle a sinusoidal terrain with a period of only three 
times the vehicle length was of interest. The particular las- 
er/sensor geometry was found to limit the reconstruction of 
the terrain accurately when the vehicle had a rapidly changing 
pitch. In each of the boulder- crater field tests the rover 
reached its target - even when the vehicle was almost bouncing 
due to the "rubble " beneath its tires. Although some of these 
tests have been rather extreme, they give an example of how 
the modeler reacts under the most adverse of conditions. 



PART 6 


CONCLUSIONS 

A terrain modeler employing vastly different tech- 
niques than the methods used by previous modeling schemes 
has been proposed in this paper. Each of the earlier model- 
ing attempts encountered problems with its slope estimations 
when terrain steps were present. This was due to the quan- 
tization errors that are inherent with a laser/sensor data 
collection system of the type used on the Mars Rover. These 
errors were greatly reduced and almost eliminated when a thin- 
ning algorithm removed data points that were too closely spaced 
(in range) before any further processing was performed. 

The heart of the modeler was a dual filtering scheme 
that essentially separated the problem of identifying step and 
slope hazards. The returns from the scanning elevation mast 
were known height and range points. This raw data was light- 
ly filtered for the terrain .height estimates. These were ex- 
amined for sudden steps that the rover might not be able to 
climb. Some raw data was more heavily filtered forming a ser- 
ies of slower varying points which were used for the slope es- 
timates. 

The results of initial computer simulations indicated 
excellent predictions by the modeler of the actual terrain. 
Boulders and craters were distinguishable to within a few centi 
meters; slopes (both up and downhill) were determined to within 
one or two degrees. The fact that negative obstacles were more 
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readily apparena is significant in jtself; several earlier 
modelers had problems detecting them. A crosspath obstacle 
detection algorithm that had been implemented also was found 
to work extemely well. Crosspath hazards were easily avoided. 

A second round of simulations involved moving the rov- 
er over a variety of surfaces: sinusoidal terrain with a per- 
iod of a few times the vehicle length, smooth terrain with 
boulder and crater obstacles, rubble strewn boulder- crater 
fields, and finally realistic martian landscapes. The modeler 
performed well under all of these circumstances, flagging haz- 
ards to be avoided by the path selection algorithm. 

The new terrain modeler detected every type of haz- 
ard as well as, or better than any previous modeler. Minor 
refinements might benefit the modeler, but improvements should 
probably be concentrated in other areas. As was pointed out 
a number of times in this paper, the modeler would have per- 
formed better if there had been more lasers and sensors, in- 
creasing the range of sight for the vehicle. There are however, 
limits to be considered. Adding more lasers/sensors increases 
not only the difficulty in controlling them, but increases the 
complexity and the time needed for the software to interpret 
the data. Exactly how closely spaced the laser shots have to 
be should be reviewed. It may be that information of the ter- 
rain further from the vehicle could be gathered using the same 
number of lasers by varying the geometry of the mast, without 
significantly affecting the excellent near field results. 
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OF POOiC C; 


subroutine moduli 


SUBROUT l NE MODEL I 
PURPOSE: 

THIS SUBROUTINE ACCEPTS SENSOR DATA FROM SENSRl AND 
PROCESSES IT TO FIND AND CATALOC HAZARDS . 


METHOD: 

THE METRO!) USED IS A TERRAIN ESTIMATION TECUNIOUE WHERE RAW 
SENSOR DATA IS PASSED THROUGH A DUAL FIRST ORDER FILTERING 
SCHEME. THE FIRST FILTER IS A II I Gil- PASS FILTER WHICH 
ESTIMATES THE TERRAIN HEIGHT. THE SECOND FILTER IS A LOV-PASS 
FILTER VIIICU USES TUE HEIGHT ESTIMATES TO PRODUCE A SLOPE ESTIMATE. 
AFTER CONVERSION TO THE PLANET FRAME OF REFERENCE. THE RESULTING 
VALUES ARE COMPARED TO TUE APPROPRIATE THRESHOLD VALUES . 

HAZARDS ARE THEN CATALOGED. 

IN ADDITION TO THE IN- PATH ANALYSIS DESCRIBED ABOVE. A CROSS 
PATH EXAMINATION IS ALSO PERFORMED AT VARIOUS DISTANCES FROM 
THE VEHICLE. THIS CROSS-PATH ANALYSIS FREQUENTLY FINDS UAZ- 
AJU)S THAT ARF. NOT NOTICED BY T1IF. IN-PATH PROCESSING. THESE 
HAZARDS ARE ALSO CATALOGED. THIS CATALOG IS MADE 
AVAILABLE FOR USE RY THE PATH SELECTION ALGORITHM. 


INPUT: 

A - HEIGHT FILTER COEFFICIENT 

U - SLOPE FILTER COEFFICIENT 

STTH - LEVEL CROUND STEP THRESHOLD (METERS) 

SLTH - SLOPE THRESHOLD (DECREES) 

RH - ASSUMED HAZARD RAD I US (METERS) 


OUTPUT : 

XHAZ(N) - X COORDINATE OP HAZARD N (PLANET FRAME) 
YHAZ(N) - Y COORDINATE OF HAZARD N (PLANET FRAME) 
1UIAX(N) - ESTIMATED RANGE OF HAZARD N (VEHICLE HUME) 
IHAZ - NUMBER OF HAZARDS CATALOGED THIS SCAN 

1U1 - ASSUMED HAZARD 1UD1US ( METERS ) 


C.tXXXXX'AXXXXX'XXX'JZXXXXXXXXXXXXX.AX’XX'AXXXX'X.KX'X'MX'XXXXX'XX'AKXMAXXX X'XXXXXXXXXXXXX***: 

COMMON /SDIX 

1 H I TI. AS . H I TSEN . NUWT.AS . N UNSET? . NUMAZ , I NTDAT . NMDTPR. LASAGL . 

2 SENGLE , SCON , DATA, D I AG, l’OS 
COMMON /TIEUP/ 

1 TIIETNU . ALPHA, SLP I N . SLPCIVS , TALLOW 

COMMON /CHOOSE/ 

1 NNMOD.NMSEN.NMPSA.NMFAIL, INTVDB, INTSEN, INTNOD, INTTSA, 

2 INTFAL, INTCYR 
COMMON /VEIICLE/ 

1 VELNOW, HEADNC,XMRV % YMRV , ZMRV , TARLOX, TARLOY, TARJ.OZ 

COMMON /SENSE/ 

1 ASNUTU, LANCLE, RTN 

COMMON /XMOD/ 

l XliAZ, VilAZ.IUlAZ, 1UAZ.RH 

COMMON /RMOD/ 

1 RANGE 


REAL SX( 100) , XIIAZ( 100) . YUAZC 100) , IU1AZ( 100) ,TZ(50) /HU 30) 
REAL LASAGL( 30) , S ENGLE ( 30) . POS( 50,5 1 , 2) 

REAL ASMimi(50) .LANGLEC30) .RANGE! 50) 

REAL CRSZ( 7,50) ,SUM7.(7) ,CRSAVG(7) ,D1V(7) 

INTEGER D 1 AG( 50 , 50) ,LINE( 130) , IAZI( 100) ,11TN(50> 

JNTF.CF.R*2 PATA( 50.50) 

DATA IN IT/O/ , LINE/ 130* ' _* / 

DRCON-3. 14150/1 80 . O 
RDCON= 180.0/3. 14159 
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C**'*'*T*X**x*.* + *x*ltxw*xx*X*.XX:X*XX*xxxxxxXT.X**xx*XXX**'XX*MXXXXX , x**x*** i **x**x**** : 

c 

C VARIABLES USED IN MODF.I.l 

C 

C A HEIGHT FILTF.D COEFFICIENT 

C AU’llA TRUE HEAD INC OF THE VEHICLE. 

C n SLOPE F ILTF.H COEFFICIENT 

C DELTA TllUE HEADING ALONG AN AZIMUTH 

C IHA7 NUMBER OF HAZARDS CATALOGED THIS SCAN 

C lULVZ(N) ESTIMATED IUNCE OF UAZARH N (VEHICLE FRAME) 

C. Sl.TH SLOPE THRESHOLD (DECREES) 

C S'nuiES CURRENT STEP T1UIESROLD (METERS) 

C STTH LEVEL GROUND STEP THRESHOLD (METERS) 

C SX(N) ESTIMATED SLOPE ALONG AZIMUTH N (PLANET FRAME) 

G TSID ESTIMATED SLOPE ALONG AZ I MUTH (VEHICLE FRAME) 

C TH(N> RANGE OF LASER/SENSOIl INTERSECTION (RAW AND FILTERED DATA) 

C T7(N> HE I CRT OF t.ASJVSF.NSOR INTERSECTION (RAW AND FILTERED DATA) 

C XRAZ(N) X C01UID1N ATE OF HAZARD N (PLANET FRAME) 

C YHA7.(N) Y CORRDINATF. OF IIA7.ARD N (PLANET FRAME' 

C 

C 

C INITIALIZE THE SUP, ROUT INF. ON THF. FIRST PASS, THEN RETURN. 

IFC INIT. NE.o> GOTO 100 
KCAIH 5 , lO) A, R. STTH, Sl.TH, RH 
10 FORMAT! 5F10. 2) 

WR I TE< 6,20) A , B , STTH . SLTH , RH 

20 FORMAT! ///''SIX. ’** MODEL I PARAMETERS ** • ///4 IX, ’ HEIGHT FILTER ’ , 

1 * COEFFICIENT - • , F 10 . 2//4 I X, * SLOPE FILTER COEFFICIENT * *,F10.2// 

2 4 1 X, ' LEVEL GROUND STEP THRESHOLD = ’ ,F10.2, f METERS ’ //4 IX. 

U * SLOPE TUUES110LD 2 M'10.2,’ DECIDES ’ Z/4 1 X, ’ ASSUMED HAZARD \ 

4 * RADIUS = * , F 10 . 2 , * METERS * ) 

SLTli*SLTU*miCON 
DO 00 Is 1 . 100 
SX( 1)^0. 0 
XHAZC I) *0.0 
YUAZ( i) =0.0 
RHAZ( I)*0.0 
I A7 1 ( 1 ) 2 0 
30 CONTINUE 

DO 40 I* 1 ,50 
RTN( I)* 1 
RANGE! D^lOOO.O 
40 CONTINUE 

INIT* 1 

RETURN 

1O0 CONTINUE 

C«*^*******~ ********************************************** ****************** 

c 

C THE SUBROUTINE HAS BEEN INITIALIZED. IF INTERMEDIATE OUTPUT FROM 

C MODEL i IS DESIRED, HUNT OUT T11K HEAD INC. 

C 

C** ************************** *******************-*■*****************:*********** 
IF( TNTMOD. EU.O) CO TO 120 
WRITE! 6.110) 

110 - FORMAT! /V5 iX, ’** MODEL 1 OUTPUT ** f //) 

120 CONTINUE 

C 

C RIJN THROUGH THIS LOOP ONCE PER AZIMUTH TO PERFORM THE IN-PATH TERRAIN 

C PROCESS 1NG. 

C 

C*************** ************** ************************************ *****:***:**:* 
1HA7.2 0 

DO 000 I AZ* 1 , NUMAZ 
KTN( ! AZ) * 1 
RANGE! IAZ) = 1000.0 
1SAVH* I H AZ 


i! 
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c ******* *** *T ******* t***t*x*rrx* *t ************************** t***,x*T* + + + x* 

C 

c f i nsT . detfrmine true azimuth ancle to properly locate hazards 

c IN TIIK PLANET FRAME. 

c 

C******»******** *■**»***. ***))x**at**xx,c*y:***:(c**xir**xal6»txxx:*;Kj:**acjracj::.*arjcjr:,acacxxj|cac* 

■n: M j'- headhc* asmutik i x/. > * alpil\ 

! ! ( TEMP. LT.O.n) TLMP*). . 26:11 l»*TKMP 
! F ( TEMP . GT . •) . 2(13 1 0 » Th Ml* -TEMP- 6 . 263 11! 

C** ****##*»■#.< **^^-***<^.*^******A*».*******Kij **■<**»:* ************** ****** ******** 

C 

C DETERMINE MIDPOINT OK ALL SENSE REGIONS PRODUCING RF.TUKM SIGNALS 

C AN!) STORF. THEM. 

(j 

C**************************************#***********:*********^**:***:****:*****^* 
IGOUN r*» 

T»0 200 IL* 1 . NUMLAS 
I HOLD 5 DATA! 1AZ.1L) 

1 F ( 1H01.I). l.R. 0) CO TO 200 
I COUNT* 1 COUNT* 1 

ipi.s* uioi.n* i 

TZ( 1 COUNT) *(POS( 1L. 1PLS, 1)+P0S( IL. 1110LD. 1) )/2.0 
TR( 1 COUNT) * ( POS( IL, I Pl.S . 2) + POS( IL. I HOLD. 2) 

SX( 1 COUNT) = 1.0 
200 CONTINUE 

C*XXXXX* X XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX 

c 

C ORDER THESE POINTS IN TERMS OF INCREASING RANGE. 

C 

C4X»**»* ********************** X ** ***** ****** ***** **************************** 

IX- I COUNT- 1 
I F( IX.LE.O) GO TO 230 
DO 220 IJ = I , IX 
I R s IJ 

210 !P!i?*IR+1 

IF(TR( IPLS) .CE.T1U 1R)) GO TO 220 

XHOLD* TR( IPLS) 

TIU IPLS) =T1U HI) 

TH( TR) = XHOLD 
XHOLD = TZ ( IPLS> 

T7.( TPT-S) sT7.( I R> 

TZC I R) = XHOLD 
I R- 1 H- 1 

! F ( IR.LE.O) GO TO 220 
CO TO 210 
220 CONTINUE 

230 CONTINUE 

o* xxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxxx*** 

c 

C PRINT OUT RAW DATA SAMPLE POINTS IF DESIRED. 

C 

Cxxxx*x*xx±**x**x**x***x*x**xx*xxxxxxx*xxxxxxxx**xxxxxxx*xxxxx.xxxxxxxxxxxx*xx 

1 F( »NTMOD.EO.O) GO TO 390 
VR!TE(6,300) LINE 
FORMAT! ’ 0’ . 130A1 ) 

AZH= ASMUTH( IAZ)*RDCON 
WRITE! 6,3 10) AZli 

FORJIAT! *o AZIMUTH = * . F7 . 2 . * DECREES ' / ’ OS AMP LED TERRA IN POINTS:’) 

IF! i COUNT. L(J . O ) WRITE! 6 , 320) 

FORMAT! * ONO SAMPLE POINTS’) 

IF< iCOUNT.EO.O) GO TO 390 
I Ss I COUNT 

1 F( 1 COUNT. GT. 20) IS = 20 
WRITE! 6.330) ( TR( I) , I = 1 . TS) 

FORMAT! ’ ORANC ’ , 2X. 20! I X, F5 . 2) ) 

WRITE! 6,340) (’TV.! 1) . 1= 1 . IS) 

FORMAT! ’ UElGirr: ’ , IX. 20! IX, F5.2) ) 

IF! T COUNT. LF.. 20) CO TO 390 
IS- I COUNT 

TF( ! COUNT. GT. 40) TS=4o 
MUTE! 6,350) 1 TIU I) , 1 = 21 , IS) 

FORMAT! ’ORANCE: ’ ,2X,20< 1 X. F3.2) ) 

WRITE! <.,360) (TZ( I) , 1 = 21, IS) 

FORMAT! ’ HE I CRT: ’ , lX,20( IX.F5.2) ) 

IF( I COUNT. LE. 40) GO TO 390 
1S= I COUNT 

WRITE! 6, 370) ( TR( I » 1 = 4 i , IS) 

FORMAT! ' 0 RANGE: * ,2X,2o( IX, F3.2) 

WRITE! 6, 380) ! TZ< I ) , I = 4 1 . IS) 

FORMAT! ’ UK I CUT: ’ , tX,20( IX, F5.2J > 

CONTINUE 
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C 

l att empt to correct any sensor quantization errors by eliminating 

C SAMPLE POINTS SPACED TOO CLOSELY TO PREVIOUS ONES OR POINTS 

C UEYOND U.S METERS RANGE. (THINNING ALGORITHM) 

C 

IF( I COUNT.LT. 3) CO TO 46" 

SUM-0 . f* 

FT!M=TR( I COUNT) -TR.( 1) 

DO 400 iJ”2, ICOUNT 

IFCTTU TJKOT.3.5) CO TO 4\0 

Irt= IJ-1 

AD TFF= ARS( TR( T.T)-TR( TM) ) 

I K ( AD I FF . GT . FT I ID S UM= S UM+ FT I M 
IF( ADIFF. LE. FTIM) SUW*SIJW+ AD TFF 
AVOSUM/C IJ- i) 

KTIM=AVC*5.0 
400 CONTINUE 

410 A A VC -A VC/2. 0 

DO 440 IJ=2, ICOUNT 
IFCTIK M) .CT.3.5) SX(IJ>=0.0 
IF(TR( IJ) .GT.3.5) GO TO 440 
1M= U-1 

420 IF(SX( IM) .NE.0.0) GO TO 430 

i n- 1 m- i 
GO TO 420 

430 D ! FF=TR< l J ) -TR( I M) 

IF(J)TFF.GE.AAVG) GO TO 440 
li’( AHSCTZC 1 PI) ) .GE.AJ3S ( TZ( 1J) ) ) SX( IJ)=0.0 
IFCABS(TZ( IM)) . LT. ABS( TZ( I J) ) ) SX( IM)=0.0 
440 CONTINUE 

IP=0 

DO 450 1J= l .ICOUNT 

IFCSXC TJ) .EQ.,0.0) GO TO 450 

JP = 11*4*1 

T7.( IP) =T7( U) 

T1K IP) -T1U IJ) 

450 CONTI NUT. 

ICOUNT* IP 
460 CONTI NUT. 

C 

C IF THERE ARE LESS THAN HALF THE TOSS IDLE NUMDEH OF RETURNS 

C OR IF THE MOST DISTANT RETURN IS LESS THAN 1.5 METERS AWAY 

C THIS AZIMUTH IS CONSIDERED TO HE HAZARDOUS. 

C 

I X= NtJMLAS/2 

IF( ICOUNT. LE. IX) GO TO 500 
IF(TR( ICOUNT) .CE. 1 .5) GO TO 550 

C 

C THERE ARE TOO FEW RETURNS TO MAKE THIS A SAFE PATH. CATALOG AN IN- 

C SUFFICIENT DATA HAZARD. 

r* 

L, 

500 IHAZ= IHAZ+1 

1F( IHAZ.CT. 100) CO TO 1000 
RTN( I AZ) - 0 
1AZ1( 1HAZ) = IAZ 
RNG= 1 . 0 

IF( ICOUNT. LE. IX) GO TO 510 
RNG=TRC ICOUNT) 

510 IU1AZ( 111AZ) = UNO 
RANOF.( IAZ) =RNG 


C* ar ***»:*:* ar* *,**:*». ».*x at* r.x* **c xjex***#:*c*:**:K:*ac*:***:#*****y3j::******#;fc*x***au ,*:**:** 

c 

C HANCK IS Tim T) I STANCE TO THE HAZARD. PU THIS INTO ITS X. Y COORDINATES 

C ( PLANET FRAME J . 

r 

C***X*XX*X*XXXX*XT-**XT.XXXT.XXXXT.r.T.T.*.T.*XXXXX**XXXXXXX:XX*:X*:X:XXX**XXXXXXXXXXXXXX*.' 

I K( TEMP . CT. 1 . 570H) CO TO 520 
AN G= TEMP 

YllAZI l MAZ) - YMRV+RNO*COS( ANG) 

- XHAZ( I HAZ) s XMRV+ RHC*S I N ( ANG) 

CO TO 550 

520 IFCTEMP.GT.3. 14159) GO TO 530 

ANG- 3 . 14150-TEMP 
YH YZ( I HAZ) = YMRV-RNG*COS( ANG) 

XiLiZC lHAZ) - XMRV+RNG*S 1 N ( ANC) 

CO TO 550 

530 1 F ( TEMP . GT. 4.71 239 ) CO 'H) 540 

ANG=4. 7 1239-TEMP 
Y1LAZ< 1 1JLAZ) = YMUV-RNC*S 1N( ANG) 

XHAZ( I HAZ) =XMRV-RNC^COS( ANG) 

GO TO 550 

540 ANC= 6 . 283 1 8-TEMP 

Y1L\Z( 111AZ) r YMRV+RNC*COS( ANG) 

XHAZC I HAZ) = X?tRV- RNC^S I NC ANG) 

550 CONTINUE 

C * * x XX*:* x * y:* * xv: x * *:* * a: * x a: * x acx * x xxx a: x * ** * ?ta a: * * * * x a: a: a: a:* a: ac a: * ;p ** * ac * * * *: * * * * * 

C 

C REG IK TERRAIN FILTERING. 

C FIRST, DETERMINE TUE TRUE SLOPE OF THE VEHICLE ALONG THIS AZIMUTH. 

1. 

DEL'TA r ASMUTHf IAZ)+ALPHA 

TS X D= ATAN ( TAN ( SLP IN) *COS ( DELTA) -TAN C S LP CRS ) *S l N ( DELTA) ) 

SX( 1 ) =TS I D 

C 

C NOV RUN THROUGH THE FILTERS. 

C 

C^*******a:a:*: samara:** ****¥**3:***^**:/:* ?.T.XT-XX**X*XXT.**XXXX***XXXXXXXXXX*XX*XX:ZH*X* 

1 F( 1 COUNT. LE. i > CO TO 810 
ISUP= 1 
TSK-O.0 
DO 000 I J= 1 , 7 
CUSZ( 1J, 1AZ)= 1000.0 
DIV( IJ)=0.0 
SUMZ( 1 J) -0.0 
600 CONTINUE 

DO UOO IJ-2, 1 COUNT 
IM* IJ-1 

rzt 1 j ) = ( ( 1 . 0 - a) * rz( 1 j) ) +< a*tzc im) ) 

c x* x XXX* x xx x xxx xxx x x x x* X 3 : xxx x x xxx X x x xx x x XX X XX X XX * * * * * x x x * * * * * * spy: * * x* * * * * * * * * * 

c 

C GET THE DATA TO BE USED IN THE CROSS-PATH ANALYSIS. 

C 

CX*XXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXXX¥XXXXXX*XXXXXXXXXXXXXX*XXXX*XXX* 
IF(Tll( IM) . LE. ( 1.25)) CRSZ< I, 1 AZ) =TZ( ifl) 

I F( ( TR( I.J) . GT . ( 1.25)) . AND * ( TR( IJ) . LE. ( 1.5))) CRSZ(2, IAZ) = TZ( IJ) 

1 F ( ( Tilt IJ) . GT <* ( 1.5)) .AND. CHIC 1 J ) . LE . ( 1 . 75 ) ) ) C11SZ(3, 1 AZ) = TZ( IJ) 

IF( (TR( IJ) ,CT.( l .75) ) . AND. < TRC IJ) .LE. (2.0) ) ) GRSZC4, IAZ)-TZ( IJ) 

IFCCTRC IJ) . GT .(2.0)) .AND. (TRC I J) . LE. (2.25))) GRSZC5, IAZ) =TZ( IJ) 

IF( (T1U IJ) .GT. (2.25) ) .AND. (TRC IJ) .LE. (2.5) ) )• CRSZ( 6 , TAZ)=TZ( TJ) 

IF( C TRC IJ) .GT, (2.5)) .AND. (TRC IJ) .LE. (2.75) ) ) CRSZC7, IAZ)=TZ< IJ) 

TOK-t ( 1 . 0-13) *ATAN( (TZC IJ)-TZC IM) )/(TR( IJ)-TR( IM) ) ) )+( R*TSK) 

ESTSLP = TS ID+TSK 
SX( IJ) -ESTSLP 
IFCISUP.NE.n GO TO 800 
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r 

C UEG1N DETEIU1 1 N AT 1 ON Foil HAZARDOUS AZIMUTH. TEST SLOPE THRESHOLD. 

C 


{j***«****x***x*x*txxm*x**x*xii!xr.xi:**^i:^xm*x*i:xm<***»**xm**^xx**^^ 
IF( ABS( F-STSLP) . GT. SLTH) 1MM* l J 
ABS(LSTSLP) .CT.SLTH) GO TO 700 

C 


C DETERMINE PRESENT STEP THRESHOLD AND TEST. 

C 

C***xxi»*xxxxxxxj:xxxj«*i!*ma:**x*xx*mrj:*mx**«r^rj;*xmx*r^x»xr«:*xx«v:*y^3; 

stores* stth 

AES = ARS( ESTS1.P) 

I FI AES.GT. (SLTH*. 67) . AND. AES . LE. ( SLT11*3 . /6 . ) > STORES* SITH/H . 

I K( AKS.CT. (S1.TH«5.^6.) ) STORES* STTH/4 . 

DO 6 10 ICUK> 1, IM 

i mm- i .i-i cm: 

D I FF=TR( IJ)-TR( IMM) 

IK( 1>I!*T.,T.STHRKS) CO TO 6 10 
IF( ICIDC.r.a. 1) GO TO 620 
I F ( !> I FK . Ed. STHtlES ) CO TO 620 
1 MM- I MM+ 1 
GO TO 620 
610 CONTINUE 

620 ESTD!l*TZ( 1J) -TZ( 1MM) 

ESTDH=ABS( ESTDH) 

- iFlESTDU.LE.STUJlES) GO TO 000 

L 

0 CATALOG SLOPE OR STEP HAZARD. 

C 

70U CONTINUE 

ISUPsi) 


1LNG=T1K l MM) 

IHAZ= THAZ+ 1 

1 FI 1HAZ.GT. 100) GOTO 1000 
IA7K I HAZ) = IA7 
IITNC IAZ)*0 
Fi.HAZ( THA7)=RNC 
RANGE ( IAZ) =IUIG 

C 

C FIND THE X,Y COORDINATE OF EACH HAZARD. 

C 

IFC TEMP. GT. 1.5708) GO TO 720 
ANC* TEMP 


YHAZC I HAZ) * YMRV+RNO*COSC ANC) 
XHAZC IHAZ) = XMRV+RNG*S INCMG) 
CO TO BOO 

720 IFCTEMP.GT.3. 14159) GO TO 730 

ANC" 3 . 14159-TEMP 
YHAZC IHAZ) = YMRV-RNG*COS( MG) 
X1IAZ( IHAZ) *XT1RV+RNC*S INC ANG) 
CO TO 800 

730 1F< TEM1\ CT. 4. 71239) CO TO 740 

ANG=4. 7 1239-TEMP 
YILAZC 1UAZ) - YHHV-IUH S INC ANC) 
XHAZC IHAZ) = XMRV-RNG*COS< MG) 
GO TO U00 

740 ANG= 6 . 283 1 8-TEMP 

YHAZC IHAZ) = YM11V+HNG*C0S( ANG) 
XHAZC IHAZ) *XMRV-RNG*S INC MG) 

800 CONTINUE 


Q9 

x — 


< 

C PRINT OUT FILTERED DATA IF DESIRED. 

r 

(;**«*w**********x***x*rii»**l****xx*/;x***j:a;*rx**x*aa*»**a;3{3;*a;x**xx******** J «:** : *: a:ii 

UHi CONTINUE 

! KC I NTMOD . EQ . 0 > CO TO mtu 
1K( ICOUNT. Eft. 0) CO TO *>0*» 

DO It IR 1=1, I COUN'I 
SX! I)=SX( 1>TJU)C ON 
Bin CONTINUE 

ISAVII^ I UAZ- IS AVI! 

WRITE! 6 * 820 » 

820 FORMAT! • 0 TERRA IN ESTIMATES: * ) 

IS- I COUNT 

IF( I COUNT. GT. 20) IS=20 
WIUTE( 6 , 1123 ) ( TRC l ) * I - I , IS) 

B25 FORMAT! * ORANGE: # ,2X,20! 1X.F5.2)) 

WRITE! 6 , 830) ( TZ( I ) , I? I , IS) 

830 FORMAT! * HEIGHT: ' • 1X.20C 1X.F5.2)) 

WRITE! 6,033) ( SX! I) , I- I, IS) 

833 FORMAT! * SLOPE: *, 2X. 20! IX, F5 . 1 ) ) 

IF! IC0UNT.LE.20) 00 TO 070 
IS= I COUNT 

IF! ICOUNT. CT. 40) 1^40 

WRITE! 6 , 840) ! TR( I ) , 1 = 21 , IS) 

04ft FORMAT! ’ORANGE: ’ ,2X,20( IX.F5.2) ) 

WRITE! 6 , 845) ! TZ! I) , I =2 1 . IS) 

045 FORMAT! ’ UEIGUT: ’ , IX. 20! IX.F5.2) ) 

WRITE! 6,850) ! SX! I ) . 1=21 , IS) 

G50 FORMAT! * SLOPE: V, 2X, 20! IX. F5 . 1 ) ) 

IF! T COUNT. LE. 40) CO TO 870 
IS= ICOUNT 

WRITE! 6,855) (TR( 1 ) , 1 = 41 . IS) 

855 FORMAT! * ORANGE: * .2X.20! LX.F5.2)) 

VRITK(6.fl6ft> ( T7.( 1) , 1=41 , IS) 

G60 FORMAT! * HEIGHT: • f 1X.20! IX.F5.2)) 

WRITE! 6,865) ( SX! I ) , 1=41, 1S> 

G65 FORMAT! 1 SLOPE: * ,2X,20( IX, F5 . i) ) 

870 IF! ISAVH.EO.O) CO- TO 400 


IF! ISAVU.EQ. i) WRITE! 6 . G75) 

R7S FORMAT! -0 1 HAZARD CATALOGED Off THIS AZIMUTH. ’> 

IKC ISAVU.EQ. J) GO TO 900 
VR rTF,( 6 , R80) ISAVH 

880 FORMAT! 'O’ , ID, ’ HAZARDS CATALOGED OH THIS AZIMUTH.’) 
9mi CONTINUE 


c* ***** *■* ^T.^.********************^!^.*^***^:***^:*.*^: sc****** ** * ******** ** ********** 

c 


C AT THIS POINT EACH AZIMUTH HAS 13EEN EXAMINED AND THE IN-PATU ANALYSIS 

C IS COMPLETE. NOV PERFORM THF, CROSS-PATH ANALYSYS. 

r 


C**^**m**tt**mmm**wt^******m**^»ii!**#*w(c*i«***«!ii****!a**,a*,** 
VRITE( 6 , 300) LINE 
CKSI’TU'SLPCHS 

S TORES =STTH/. 88 , 

SLOFTIUSLTH 

1 F ( ABS( CRSPTH) . CE. SLOPTH) COTO 910 

DO 970 1 J= l,7 

DO 970 1 AZ= 1 , NUMAZ 

1F< 1AZ.EU. 1 ) COTO 970 

IF( CRSZ( IJ, IAZ) .LE. 100. )GOTO 905 

GOTO 970 

905 IF! CRSZ( IJ. IAZ-1) .GT. 100. )COTO 970 

CUX= ( CRSZ( 1 J . IAZ) -CHSZ( 1 J , IAZ- 1) ) 

I F( CRSPTR. GE. SLOPTR*. 67) GOTO 950 
1 F( CRSPTH. LK. ( - . 67*SL0PTU) ) GOTO 960 
I F( CRSPTIT. CE. (0.0) . AND . CHK. LE. -STORES) GOTO 911 
1K( CRSPTU.LT. (0.0) . AND. CUK. GE. STHllES) GOTO 910 
IFCCHK.LE. STORES) GOTO 970 

910 1AZT=1A2 
GOTO 9 1 2 

911 1 AZT= 1 AZ- 1 

9 1 2 RNO= 1 . OO+FLOATC IJ) * . 25 
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t L. (r •iff**** <y r 'A- ' 


C*y****xy**yyyyy.yyy.x*:*y.*yyy.r.y.y.*y.:K**y*:fc*:»:*y.****yy:#«x*a**::*****xx**x*******X***y*** 

C 

C IF THERE IS AN IN RATH OBSTACLE CLOSER THAN TUE CROSSPATU HAZARD, 

C IGNORE THE CROSSHAIR RESULTS; OTHERWISE CATALOG A CROSSPATH HAZARD. 

G 

0$>*^****^^3|t»3(nit******x**3t»x*xacx»x*»:xa:xr4:x***x**a:***J(c***^*xxz*r4:za:x^xrrr4:3:* 

I Ft IRAZ. EQ. 0) GOTO 925 

00 920 K“ I • I HA7. 

IF((IAZI(K). EQ, I AZT) . AND. ( RIIAZt K) . LE. RNG) ) GOTO 970 
920 CONTINUE 

925 AZII= ASMUTHt I AZT) *RDCON 

KKITEt 6 , 930) AZII 

930 FORMAT! * CROSSPATH HAZARD CATALOGED ON AZIMUTH * ,F7.2) 

1 LAZ= lllAZ+I 

I AZ I ( IHAZ) =T AZT 

UTN( I AZT) - 0 

RHAZt IRAZ) -RNG 

lLANGEt 1AZT) = llNC 

I Ft TEMP. GT. I. 5708) GOTO 935 

ANG=TOU‘ 

YHAZt IHAZ) =YMRV+RNC*COSt ANG) 

XILAZt lUAZ)=XMllV+RNG*SiN< ANG) 

GOTO 970 

935 I Ft TEMP. GT. 3 ■ 14159) GOTO 940 

AN 0=3. 14159-TEMP 

YHAZt IHAZ) = YMRV-RNG*COS( ANC) ' 

XILAZt IHAZ) =XmiV+RNC*SiNt ANG) 

GOTO 970 

940 1F(TEHP.GT.4.71239) GOTO 945 

A NG= 4. 7 1239-TEMP 
YHAZt IILAZ) =YMRV-RNG*SINt ANG) 

XHAZt I HAZ) - XMRV-RNO*COS( ANG) 

GOTO 970 

945 A NC= 6. 28318-TEMP 

YlLAZt IHAZ) = YMRV+RNG*COS( ANG) 

XHAZC IRAZ) -XMRV-RNG*SIN( ANC) 

GOTO 970 

950 I F ( GRSPTH . OF, . SLOPTR* . 83 ) GOTO 955 

IFCCIDC.LT. (-.5*STHRES) ) GOTO 911 
GOTO 970 

955 IFtCHK.LT. (-.25*STHRES) ) GOTO 911 

GOTO 970 

960 I Ft CRSPTH. LE. ( - . 83*SL0PTH) ) GOTO 965 
I Ft CHK. GT. ( . 5*STRRES) ) GOTO 9 1 0 
GOTO 970 

965 1 Ft CUE. GT. ( . 25*STURES) ) GOTO 9 10 

9 70 CONTINUE 

GO IX) 1020 

C 

C HAZARD LIMIT EXCEEDED. 

C 

C *****************v********y^y^******yv:***********^******y^yyyyyyyyyyyyyyyyy 
1000 Wit 1 TE t 6 t 1010) 

10 10 FORMATt ///' OVER 100 HAZARDS CATALOGED - PROCESSING TERMINATED. • ) 


** ’■:> 


*************** *x***********.*sca;x xxxxxx* 3 r. 3 r.xx:T.*.xr.x:r.r- 

C. 

C ORDER ALL UAZARDS IN ORDER OF INCREASING RANGE. 

< 


.IT, 


1020 CONTI NUT. 

IX= 1 1L\Z- 1 

IF( IX.I.R.O) CO TO tono 
DO 1040 IJ=1,IX 
I R= 1.1 

joao iplsmr-h 

IF(RHA7.( I PI-*:) . CE. RTIA7.C IR) ) 
XIIOLD=RnAZ( IPLS) 

PJIAZC IPLS) =RHA7.( IR) 

R1L\2( IR)=XHOLD 
XHOLD= X1IA7.! I PI «?) 

XHAZ( IPLS) =XHAZ! IR) 

XUAZ! I Jl) * XHOLI) 

XHOLD=YHAZ( IPLS) 

YlUZ! IPLS)=YUAZ! IR) 

YHAZt I R) = XHOLD 
I UOLD= IA21! IPLS) 

IAZIC IPLS) = I AZI ( IR) 

IAZ1! I1U = 1110LD 
SR= I R- I 

1 Ft lll.LE.O) CO IX) 1040 




CO TO 1040 


CO TO 1030 
1040 CONTINUE 
1000 CONTINUE 

C 4 i*****x****w* xxx&xxx*xxxx*xiix#*xxT.x**r.*xxx*xr.*xx*x*x***xxx**x:x***x*»x***x*** 


C 

C PRINT OUT HAZARD CATALOC IF DESIRED. 

C 




x s * u: * ^ x * * * * * y ‘x x x 




1 100 
1 1 10 


I 120 


WRITE! 6 . 1 100) LINE 
FORMAT! ’O’ . 130 A l • 

1 F( 1 1LAZ. E(A. 0) WRITE! 6 , 1110) 

FORMAT! 'O’. 35X. ' NO HAZARDS CATALOGED THIS SCAN'? 

IF! 111A2.EU.0) GO TO 113“ 

VRITE( 6 , 1 120 

FORMAT! 'O’ ,4 IX, ’ HAZARD CATALOG’ //24X, ' AZIMUTU’ , 10X, ’RANGE' , 1 IX, 
’ X* . 1 4X. ’ Y* /25X. ’ ( DEC) ’ . 1 2X. ' v M) V) 


DO 1140 1=1,1 liAZ 
I A 1 = 1 AZ I ( n 

AOUT= ASMUTUl 1 A I ) *1U)C0N 

WRITE! <». 1 130) AOUT. RHAZ! I) .XHAZ! I) , YHAZ! I) 

1 130 FORMAT! 2 IX, F 10 . 2, 5X. F 1 0 . 2 , 5X, F 10 . 2 , 5X, F 10.2) 

1 MO CONTINUE 
1150 WRITE! 6 1160) 

116!) FORMAT! ’0 ) 

1200 CONTINUE 
RETURN 
END 


f 
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